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(57)Abstract 

PURPOSE: To improve the operability of a 
master slave manipulator by controlling an arm 
part to correct the movement of the master 
slave manipulator or the movement determined 
by an operation support device when the 
interference with an obstruction is judged. 
CONSTITUTION: An operation support device 
5 having the function for detecting the position 
of an obstruction when it is present is provided, 
and when a slave manipulator 2 is operated 
according to the movement of a master 
manipulator 1 , with respect to the movement of 



the wrist 1 1 m of the slave manipulator, the 
master manipulator 1 is operated so that an 
operator can avoid the obstruction by eyes, and the wrist 1 1 m i of the slave 
manipulator is made to follow this. With respect to the movement of the arm part 12s 
of the slave manipulator, the presence of the interference with the obstruction when 
the slave manipulator makes the movement of the master manipulator 1 or the 
movement determined by the operation support device 5 is judged by the operation 
support device, and when the interference is judged, the movement of the manipulator 
is controlled. 



@&B«*iF&* (a) ¥3-104572 

©Int. CI. 5 sKSUS# Jf flSE»^- W 3 ^(1991) 5 M 1 B 

B 25 J 3/04 7828-3 F 

19/06 7828-3 F 

G 05 D 3/12 M 8730-5H 

mm* mm**. 9 (£1310 



R ¥1-237250 
©ft B ¥H1989) 9^14B 

®m W % TfT ill ^ 0 £ »^BAlrU^lIjWn68#«i ft^ttBArMf^^*^ 

@^ B| f & * IE If ^^B5r^aiBT1168« <&£ifcB£Kfl^*^ 



« * » 

/ . IS HQ ® * » 

•2 . # 5S # « *8 Bl 

mwmnt&fc^t&T&tfKtt hit 

SlfelffSIKi!:«»4i:iitt:. ±53 
BBKift CS«t5 J: -5 KM* U. ± IB a f - ^ 



■fe ;u ii , i^-J'ffl^MSSfli 
R«flaittN»flfc*Al'. 2£ I £ BS Si ft £ 

» a> * » *v tt # *. e. *. & 1 0 w m ft & * 0 * * 

S It 5 t % C . iEXIz-^V^tTaU-* 

B?6ffiS«#Mi!iftt±±se7Xj7zt:iu- 



— 449- 



U . £SXI/-y7:fil/-JK07-A 
&©&B§jftm±±E&#£MiS6t;*'itf5a;*iv 

ft. 

. XU -^7:= fcTa U-* ©Jfe»SfcK*S» 

•^iL6iifelflHafll:45iii:±axi/- 
77i£at/-Jr©7-AgiS#KIS5&IJ*>Lfc 

a u-* aura 



!f ia ¥3-104572 (2) 

±ESft3£«S£B*6dJ;&S*vSBiail8®#fc 
.fca.fc-5K:1W»-i-*vxjrxu--7M*«Bfc. 

**J:dC_hEXU-3rv-fcra.I;-i>©7- 
fflK<fcy±E¥##fcai2<;fc 

at-* & it *v if 4 *. 6 n fc i n m m n & t © * * 



A'&±«svx*T = fc:ai/-*©**»©at»5 

-7'vifcriU-i'©7-AgIl(D«-B8HSftS:± 
S.k^lclWWTavxi'Xl/-:*'*] misfit* 

. fftS^Jhfcxi/- 
yT=tTa.i/-f©^*^««f«fcMiEB»B5 
i»ftfc/i»£|g£fcfc©Ti*©#£SfcffiT*~ 
k fcW«k1-S»**3 % U < t±4 Ett©v* 

5te«t^a&i8itattfec. » # a ict y » 

«8ttil»*«3*L<tt4g8<!)7AM 
. b51BX 1/ -7 v - tf a. 1/ - 9 © 7- A&©«- 



l/-?7;l^al/-ji(!)IHj)lil. 

8. *"Cl/-*/v©*##Bfcl!HJ. mf SB Sk £ 
ffl $S B tt . t»ET##**i:««LfcfcSfctt 

4E«©^X*XU-7'*'.re J .l'-i'<7>f£()13} 
SB. 

9. mf EX r: tf a. U - * © & « giS £ » ffc 
a*.fc-fcE5fc*S91©B«i«»«S::>J-'<l'-i>fc3i 

3 1/ - * ©««KRt. 
J . **©#»& 



7 ^Ui/-^7;fii'-Jlt. # "« u - * 

ffx5±^:lfetf)*ife5. If # B5 SB 58 - 
132471^- C5«iE*Vfc%fflt?tt. Xl/-??-^ 

*#iSiksiiS£ ttt. 3fS©asa&^*iS] tig 



£0>»f1sftW«>«*fCfT xtf . M So 

caw^jRi* bio ttana] 

£ ic it , X 1/ - 7 v - £ a. l> - * # -t © J» ffl 

■r a u*>t. xi/-?7:tr 2 i^- 

>7 = t:il/-»«) M tragic 

•e . Rfft*>xu-^7-iJau-*i!)aiats 
*«Bac5swi±. ^u-y-7-tf3.i>-#kSf 

Sft#T#-fa<a&*&*J:<IS«-eSa.}:'?>K:-f 



iE OgBtt, W gfr tfgfffi g ffl fit 

-.ti fflft^^JC. X y - .7 V - H .a. 1/ . - 

Si^t;*l«U-77;f al/-*ffl#f 

& an a s * . x u - ^7 - tr j. u- — * © 7 - a as 

fflBSlCTPTIi. -7X?vr-t:a.u-*fflJBi* 

% 5 w± a # s a s B c a y » fc ft * & u fc t 

%®Lmm.K & ^>X t&V 7,>f? - Z 3. V - 9 <T)9S 
£fc5Mtti«#£«gei::±y#*>feftS«:«IE 



BUT . * UlUti. » 1 IB 

^k^it/-* (RT*t7XjitSi-S;) 3t x 1/ 
-■/^•^t^o.U-i' C^T^ttXlz-yt^/JO 

-7»7-AS3«£l3i8SHilP*:ff}*i-e:&a. * 
lltfint. 7XJHIi#fllm5)3&AKJ; 

-ASB12m04 g*«&^b, K^20itj#O!T 
Jml~Jm4(7-A3S) . Jm5~Jm7(^ 



-451- 



mfcb. *©BBj8 A & 8 m 1 ~ 9 m 7 

fc-fS.&BSglSJmi (i = l~7) fc x ;/ K x 

flt*flit«xi'3-Jf*>6j88. MSSRS li 'J > 

x?*10s©lilfcS8:O : 7-AglH2s©4j=!il 

JR.^21©«Sffl! J: U (HKBBffi S: J s 1~J s 7 fc 
U * © 88 S5 ft & 8 s 1-8 s 7tt J. #BS® 
J s i(i = l~7Jtx>Hx7x*#10«ttBB 

n - *r * e. f« a . B8®wt±y>?i?5ttt«*vT^ 

# . ::Tlt, xt,-7'2tf7gf&J& ( x v K x 
7 x V 9 I0»© i * « & SSt <)« « . 51S§I&£«: 



51 rfl¥ 3-104572 (4) 

f rS«It«:-»TV>5. iy|<i7iJjil0s 

it. x i\> h <t> m toft* * ft < y * v b u^^-m. 
v « ir v ^ » » #«^>f»?ou'Ki7t 

» # tt H . S5»5:®IP5'rst.©r'»a. v X * A 
l/-7Kait4 ttvxjtfflf 8i:iij7^* l 

Tl>5. 

fS2@H±VA*XL/-7#J«(?!l£tt4ffl;\ai7Jm 
•!§• © lit lit. VX;5rl©«-BgSi5©ia«K^l8mi _ 

( i = 1 ~ 8 . ::i!i = 8lti>h'x7iJii 
10 s ©B«g«S:3i:»-r-Si:-r2.. *fc«TTtt: 
©(i = l~7), (i = 1~8) *?©!25£&, 

miilllAtJ. tfex ©#B8»©HSB 
fl8siS(3t9tLtAil/. # B8 85 © * - 

» mm i » i &ai77-ra. *&. i^ssss* 



■ lBJiyft.S. ii^lSSIUttCADf-i-A' 

^*!ftfc^iS*o = »;Stf«P. to At* IB 

SS S 1 4 li . xE© = &7Gffif«Pi:ffi«lg*Kfil5 
*6>©B«l§iflBa 8 o i fcaxiT)*©*^^. 

3SE15l±. iat;XU-72lZ)Rifl8m 

li77>M(Dxyh'x7i5M0m!EftffL. X 
l/-72SifrtTBtt«tf«&4T7* ! . C©tfs 

mi±as'»xu-^2©*5feas^*e}u<c#>=.vx 
* i isffti. ;©feto^t/-y2©#5feai© 

«¥SS7/<.ffl«?8@iltt-*'<i'-#»ffl?aSK: 
Ut:fflflSlHT8XU-7-2(!) 



vx*Xl/--/*J»SE4fc:,fca±82#Sfe£lJ© 
ffll » tt . ffllmfDS{Sft8m5~8m7kff 
11 s © B§ S5 # 8 s 5-8 s 7 fc £ A# U T . * © 
g K # « U S » I s i SrffiTJ-t* ; 

I s i = K i ( 8 m i - 8 s i ) • ■ • (1) 
(i = 5 , 6 , 7 ) 
K i : ifcto&SK 
tfei>Kx7i?>10s4W\>fy;^ H^>f 
^©iStexvh'x^xi'i'tOmffitSsftH.fcoT 

$ J*" 'J )./«D»^tt*(l)CiSoT7Xi'7>l/- 
7-«»t5. 

-7j . 7- » ttfc© <fc =) t*H»4 ti-5 . 

15 ttXU-T^WMfta s L t7 

SjK^S^J^giHHtCVXi'WSBSlift 0 m i & @ 
«tl»fl5ft 8 c i httfflJti. f»?I^SIH 



2 « 7 - A SS12 s A'BSft7CS35t5*i:^ 
SflJgb. *©J|g3£*:j£«g?»iSMl5lC'i9j£m^ 
AHTSUfJ. ««l^*KH15t±. 
A*6 7- AS512s tffiMfff3!U4mt 
tf^frSk. ^PJ&SSgHtcaiflbfeBSIBBSii 
ft 8 c i &XU-7S«l»SlSfte riHT7^ 
jxi/-?iS8l5«4i:,MtS. * fe . ffi & £ 

«t $ s 15 1± . hfrt>?&? zztftftfr 

4fc. B«B885ft 8 c i &fc© J: i> tcg!51Et4. 
SP*.y-AgP12mftt/T-A9il2sfflg(mgl±k 
fcC4fc©T?. 1 «7-ZsgS12m»{fe«t 

♦a^tJftl (*»tt**r) lCXl/-^2®7 
-ASS12s©ft«£#!lJStf4B«tB«itiSft8 c i 
lt-«lcttSt*6ft^. ^©fc&Mxtfxu-y 
2 ©WSJ ft 8 s i i: ©g© - fl»fg ; 

S = Z ( 8 c i - 8 s i )« ■ • • (2) 

ft 4 .k -J K B « BS 85 ft ». c i £ £ 60 4 . 

-72 ©T-A^lZs *5RE*« 7 Cf?lf5 C i: 
ft < ftmtf'ti*. 4 . 

S51g|©#£-fc&ft4©tt. V X * 1 # 1" 1 1 m 

4@*Kb*j?fcf. 7 - A S ft H £ . 7 0 
•fe;t/i6tfKtt&**-cv4£-e*4. = ® ' * * 1 

fflBSSI&tSSffli'J Jnil~Jm3. * © B9 ffi ft 
4Sml~8m3i:t5. 31J7A? 

4ifft5. Xl/-y2tt»lBtH&8 
g K © % © tf . xyh'X7i» jH0sCtt|!# 

7 * -fe ;ui6 1± . ^^/l/t^wiaeft&^ffl-rifc 
ftoxya-jftfrftisij. -e©^aja^--efe4 

jitii. fflfflgpfl-fcfc&iSfcBtitfliS-ei&atf 

aa>i-4± e> tern i @©«^t 



iotfiofSfSI^. t- # f 4 ft e> if . * © 
t £ © ! aSBStft 8 c i S . W**5j 7 K W£ U ft 
v> # fa k '> L ^ o £ 3C L T -T # © # * & S 4 i: 

?SSS*i,fci:S©«lB o i # B ® 95 SB ft 8 r i t 
2i;t'«tl 3 i SOiai,. B8S5Jsi$:S>J»T4; 

I s i = K i ( 8 r i - 8 s i ) - • ■ C3) 
( i - 1 ~4) 
K i : Jfcfl£K . 
Ek ± © 16 ft £ & H T tt . V X * X u - 7" Si ffl 8 

0 T ifc 4 . VX*l©eaK70S6ffl#^Ct±7 
X* 107-ASi512mffllO©B9SiSS;fc4-S« 
BS 38 ft m « # -f 4 fc s?> K . t©BBSitJmj©*tC 
ISImjSiit C j tt l'"3fflH£«) . 

IB 1 OUSfllce^Ttt. */Cl/-ii.3ttfi 

e#li£ittiit7A>u»iiiThtt. xu 



^ 2 - ff $ | llTS 7X - rx u - y-Si| »-r-4-. rra 

st a t± . m i a©»^fc ies«u:, 7xn«fi 

11 m ©08 SB ft S: Bn,l~9m3tXU-y#mils 

© H gfi ft b s 5-8 s 7 ©«•* ©HKfl:8l L fe 
««TDB»JBl~Jm3feK»r«. XVKI 
7 x ? * 10 s ©fclfct. HtS? & 4 . 

jn/-72©7-Aau2.«>M*tta-F©»y 

"C&4. *^JSWT?1±, -V X* 1 tC7- AgSA'ft 
V>*>£. Xl/-7-2©7-AS5©gto©B«tlMai 
ft8 s 1-8 s 4 & 7 X * l©7-AgM>e.#4 

ifcttTSttw. t;fSMIRS5ti, xu 
-7-2©i»S5ftBsi£A#bT. if^-^ 

2©$£LIs©#IrI'<J' Ml/"?£ft:£T?#ft4. 
? = CC.CsCiCCCe, • • -(4) 
C, ; XU-7"2ffli#B©W2B©4 X 4 © ffi 
Sfii7KU?Xffli}iOJ6ft»3 X3v 
h'Ji'A 

t, ; 85 7H@S«S^^»T?©Mfi5*^«ffl^ 

453- 



0 V IV = ( 0 , 0 , 1 ) 

|6|tiitx«, y tt. z tt a y © . 

MiZ)3X37h'J?AiC« ( 8 ) , C, (9). 

c z (Oktit 

C x ( 8 > = f 0 0 0 



0 0 1 

C, = C z ( 8 s 1 ) , C, = C* ( 9 s 2 ) 

C, = C r ( 8 s 3 ) , C,= C r ( 8 s 4 ) 

C, = C» (I s5) , C, = C, (Hi6) 

C, = C t (!s7) , 



\m ¥3-104572 (6) 

m®m&mni5&~ g ^Bassft s r i sst&r 

7 = Kve • - - (8) 

K J: U # ft 5 . Kv#0BtSXl'-7'2tt$f 
lls^ttftt. 7 - A giS 12 s tt ft if fc ^ . £©& 

&t? x u -zf z ©#& & a *>-r t * t . xu-7 

2 ©B3S5 J s 1 ~ J s 4 ©MgBftig& 8 s i (i 
= 1-4) ©-«« & 5 ; 

ts = J + -v + ( I - J + J ) u • • • (9) 
fc fc* L> 

j;t:t'j5 5l(v = J-Jsi) 

J + ; J ©S«&ft?<! 

I ; *ttf? M 

u ; ft ft ? h /!> 

f . = (Ill, 8 s 2 , 8 s 3 , 8 s 4 ) 

t 9 tt - a t tt tfc * 6. ^ © -c J "8* » I 1 1 s © 

( 8 o 1 , • • • 9o4) fcU, i St BS IS ft 9 c 



"?o = (9ol, 8c2, 8c3, 9o4) 
= "9* s + t • t a • • ■ (10) 

85 1 © IE JS W K & ^ T tt . 1B7-AS 
iUASS^5B5I«Srol~9m4tffti8(0@ 

*3lffi^-ett. i(io)®?c«s;*,cfflat5l 
s*ufc@^Bgiiifte C ifca«^^Kai3A»60 

®«t-*p±U ?#©#*© 

-C -T * & « £ tt T # fl 5g IS SI 14 tt W S © ^ A 

kLTfS4'4t>ctiSU. « «< £ & £ B 1 5 

8 r i = 8 o i ^ffiAtS. T$#*SS&ttt, 
U 15 Cfl^ffl-g-Ai: 

fl 3£ 55 SI H tt © # « -p t c «iTi. xu- 



■/2»S5cffl©MSi5J »IAy^Jte<W©BII8Js4 
B8® & J s j tti. cs ©BBH5 J s j ©IS 85ft e 

«t^«RBl5*"i§a®ft9 3 j & ! «»©ft 8 c 

Xl/-^«»«B4tt. XU-72©7 
— Agill2s rorelS^ B s 1-8 3 4 fc X 1/ -7 B 
flBJifte r 1~8 r45:A*l>i:. -t © g £ Jfc 

fe. # t U — * 3ttxu--/2©#5fe©S«f£tt 

isatt77,j! uif^fha:, xu-^2© 

IB7@tt*«BB©«3©^ffiff5«:S-rfe©-e. 
§54@tcStLfc^2©^te«lC. X U - ^ 2 © $ 



ro^flls. iyKx7i>>iOsStf#M* 
«|60.lttty&». Ill«19tltTII 
»S«Bl8lcS£AU. ®«f!S*SSB18li cfflSf 
S*i.feHftft»jRra. ttoTt^iz-niic: 

tt is k s tt r & it if . *■ © a * & s §i a w m m 1 a 
•t? a » i? s a © U . a i/ -7 2 & n%<b 7 »c«s? 
Jti:t4<7x> l zmftT z =. t tfv £ & , 
&£. #*»*l©ttJliaJ#, BP*.S0lA7j3SB 
&tfH«»jn§S^££10CjivLfeS51©3l«« 
IC ft fin L T t, . BC«*&85:t)l 1 r*J. 



2 ©7- Ag|S12s ©* 'J tC3£&-fevy-22&fr 

inu. s«,ti#iaii5 (i3g) AIM 

J«KISl3tf«;t>- 3 -C®9@(Z>±i.ffev*ttaiSe 
B24&sttffe% ra-efe £ . fiS-fe v*22tt# y u 
?©B9ffiKi&ytttf uv>#, 

fc. jfi»-bvy-22t:W:Jte. i> 

fc *> © $> a . ;cT?ttft4fflnfe«CTV*T 

fefc£-fcV*fg-§-23&ffi7jL. c*vt±-fev-y-*m 
iSB24fc:Jfcy ii£*va. tt y*«kaj«K24tt=i 1 * 

lisott. xi/-r2cor-Aa5i2s©K^*ja 

iSE © 7j & T & >J . ftfc It M £ T & £ . ir > +f- & til g 
B 24 It. t>*i§23±iJT3bTK5i|>i;5: 



fc-fr*. TjHTHft^tH^tt, 5£(4)~(10)T? 

-fe>-t>-«ffl»B24-e7-Aasl2s & 7 #T 

StTV'S:i:i!i«ilii*vfetitt, T # « 5S 3S 

Ni/iJj tS^tit^j hi^tl'il, Hp 
cos y = "? j • w / ( I u j I I w I ) 

4 = C 7 C c C s C,^, 
tLTISSJa jfflaaSeiflSojfflASJri: 

T J*. «S g * 8 H 15 1; tfi # -f * . r *v ic J: 0 B # * 
7t'J>i»Lsj«!j£^<Citi5:<, ii&fa « £ 

« ft V> T , Sfi g -fe V * 22 (5 ffi 73 * f> ^ % L T t> * 



mtA'fcfri*!. A (10) V Sr fc IC ft # b fc g & 
W ffli £ 9 c itfilPCiBBt^ofeffiJSftfflia 

B H It ^ ® ffi fc » t ?J Bf U T . £ fl| * A & «i * 

S 4 gts M tc ittif a u-zr 2 ©t-ash 

12s t»*«j7t«5«ifi&ifigf-tV-t>-Z2T?*aiO 

fJJnUfcas^Jeiq^acfctJcyRicjftSfir^a 
:i*?S4. *fc?»*ffltt. ifi If * v +)- ic * 
at b fc A> . -ii.lt««i-fe>-«-|c^A.aci:t J -e 
Si. 

®4@t^tfcm2©^»Wic*?v^T. 
©SkftHWKWISrSSBZS&ttiqL. & $ 18 & IK 
5 ©^Sfflje&BMtt. 35120(73 «fc 9 lc«f^KK 

- <7) «t (& -C It . TSflgSSH*'. &2©SlfiStft 

fc H & © St & fc: J; Mi'-7207-ASti2s 



-455- 



(8 ^ Z6 ft U "C * Hf £ H25 » U fc R ffli * k tt 
H \) it * U - 9 StTgsUT^SWSSiifctt'J^ 

S * A A £ B 2 7 1± = * 7C 15 <ft ft ■» 2 9 * 2 ft 7C M ® 
aa£H2»HJfS3!J U. Hft7cS*KaSE28ttS 



^fifl ¥3-104572 (8) 
<3*29t UTffi^i U ;ftjtffl^T = lf!icS«S i 
IH S B 13 K fc V> T C A D r - i> 6 * te 1$ 

v> s © -e . T^co^Js^iW^wfseitt^^-t^ 5 - 
EstKasifflfiJftttKfc # e 0 « §s ss ffl 



iciaB-r"***. * xf xu-yv-t:i i/-* 

£ . 0BB©St»fcJSii?§ 

SB 1 0 . JB20&tf»3Htt*««(9*l«)* 

40. *5@»tfS6Btt*»i!8»!B2i!)^*W 

0l±**&«lfflf8 3 <T)%m.M<r)±K , s *r AS. <s 
80. SB 9 05.0:85100 ttsfcfSW <0 36 4 ©^SiSW 
®^»-yXf Al. Hfifilflffl^Dyi'BS 

tfjfiatv*fflEii. ®n0at/igi20tt*% 

Pf3©?S5©SSS^OT^:*->xrA0S.O t a^5M 
gS ffl yD-;?l. #130 8. tf^MS l±*IB'!8«) 



^3.1, -2, 3 - * ^ U - * - 4"-*X#*t> — 
7H»£B. 6 6-fls*»»*. 
7 »-##■« 10 m ,10 s - £ yl>'l7iH. 
lU-^lT. 12m, lZs-r-ASU. 19- 7 0* 
*. 17~@«A3£B. "~ 
j£ » -fe v * . 25-»-&£B. 27- Hft7cS*A* 
KB. 

ft 3 A # S ± * * sE % 



— 456- 



% i m 




% 2 



Imi 
Is] 



e mi esi 



. 9ri 



% 3 



15 — 
. 8ri 



«4 



9mi 9si 



-457- 



JtBB¥ 3-104572(10) 




% 7 H 




-459- 





—46a- 




-461- 



